#include "WPILib.h"
#include "Robot2489.h"

void Robot2489::ReadIOModule()
{
	// Now working!!!
	// NOTE!!! In order to clear the errors, go to configure
	// of the driver station and make sure Enhanced IO is on!!
	
	//These are disabled for now, because we need the toggles, and autonomous didn't work
	//anyways
	//RightStart = !dseio->GetDigital(1);
	//LeftStart = !dseio->GetDigital(13);
	MidStart = dseio->GetDigital(1) && dseio->GetDigital(3);
	RightBranch = !dseio->GetDigital(5);
	Slow = !dseio->GetDigital(1);
	EmergencyPause = !dseio->GetDigital(11);
	screen->PrintfLine(DriverStationLCD::kUser_Line1, "GetDigital");
	screen->UpdateLCD();
	

	
	/*
	if(dseio->GetDigital(1) == 0)
	{
		screen->PrintfLine(DriverStationLCD::kUser_Line2, "Digital 1 = true");
		RightStart = true;
	}
	if(dseio->GetDigital(3) == 0)
	{
		LeftStart = true;
		screen->PrintfLine(DriverStationLCD::kUser_Line2, "Digital 2 = true");
	}

	if(dseio->GetDigital(5) == 0)
	{
		LeftBranch = true;
		screen->PrintfLine(DriverStationLCD::kUser_Line2, "Digital 3 = true");
	}
	if(dseio->GetDigital(7) == 0)
	{
		RightBranch = true;
		screen->PrintfLine(DriverStationLCD::kUser_Line2, "Digital 4 = true");
	}

	if(dseio->GetDigital(9) == 0)
	{
		screen->PrintfLine(DriverStationLCD::kUser_Line2, "Digital 5 = true");
	}
	if(dseio->GetDigital(11) == 0)
	{
		screen->PrintfLine(DriverStationLCD::kUser_Line2, "Digital 6 = true");
	}*/
}
